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► Robot kinematics: 


► Description of motion of the robot without consideration of the forces and torques 
causing the motion. 


► The Kinematics is a geometric description. 
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Forward and Inverse Kinematics 



► Forward Kinematics 

► Determination of the (actual) position and orientation of the end-effector given the values 
for the joint variables of the robot 

► Inverse Kinematics 

► Determination of the values of the joint variables of the robot given the (desired) position 
and orientation of the end-effector 

► Notes 

► Inverse Kinematics is required to determine the control action 

► Forward kinematics is required to give feedback about end-effector pose 
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► A robot manipulator is composed of a set of links connected together by joints. 

► A robot manipulator with n joints will have n + 1 links as each joint connects two links. 
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Robot Manipulators 



► Convention 

► We number the joints from 1 to n , and we number the links from 0 to n , starting from the 
base. 

► By this convention, joint i connects link i - 1 to link i. We will consider the location of joint 
i to be fixed with respect to link i - 1. 

► When joint i is actuated, link i moves. 

► With i th joint we associate a joint variable, denoted by 

► Angle of rotation in case of revolute joint 

► Joint displacement in case of prismatic joint 
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Kinematics Analysis 



► To perform the kinematic analysis, we attach a coordinate frame rigidly to each link. 
In particular, we attach frame o^y^to link i. 

► The frame o 0 x 0 yoZo, which is attached to the robot base, is referred to as the inertial 
frame. 
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► Suppose A t is the homogeneous transformation matrix that expresses the position 
and orientation of qz t with respect to oi^xi^yi^z^ 

► Ai is a function of only a single joint variable, namely q t . 

Ai — Ai(c[i) 

► The homogeneous transformation matrix that expresses the position and orientation 
of frame OjXjyjZj with respect to frame o^ty^i is denoted by: 




/ 



■ Aj—iAj 


if i < j 

if i = j 

■ # ■■ 

it j > i 
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► The position and orientation of the end-effector with respect to the inertial frame 
are denoted by a vector 0 ° (represents the coordinates of the origin of the end- 
effector frame with respect to the base frame)and a rotation matrix R% respectively. 

► The homogeneous transformation matrix of end-effector pose H is: 


H = 


R 


o 

n 


L 0 



H = T° = 4„(q„), 


At = 


i- 1 


R L i 

L 0 


0 


i - 1 


1 J 
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► For homogeneous transformation matrix T- 


Tj — Ai+iA i+2 


a j = 


R) 0} 

0 1 


j > i 


pi — pi pi+1 
K j ~ K i+l K i+2 


R j 


j - 1 




oj—i + Rj-iOj- 1 


CCE4242- Robotics 


16 April 2016 


Review Example 



► Consider the two-link planer manipulator 


Ai 


A-2 


c i —si 0 aici 

si c i 0 fliSi 

0 0 10 

0 0 0 1 

C2 — S2 0 a2C2 

S2 C2 0 (L2 s 2 

0 0 10 

0 0 0 1 




c i 2 ~$n 

^12 C 12 

0 0 

0 0 


Note: c 1 = cos (0 1 ),c 12 = cosf^ + 0 2 ) 


s a = sinCej.s^ = si n(6 1 + 0 2 ) 
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► Denavit-Hartenberg convention or DH convention is a commonly used method for 
selecting reference frames of robots 

► In DH convention, the 6 parameters associated with an arbitrary homogeneous 
transformation are reduced to 4 by appropriate selection of reference frames 

► In this convention, each homogeneous transformation A t is represented as a 
product of four basic transformations using the following parameters: 

► a{. Link length 

► a t : Link twist 

► d t : Link offset 

► 6 t : joint angle 
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► DH coordinate frame assumptions 

► DH 1 - The axis x t is perpendicular to the axis z i _ 1 

► DH2- The axis x t intersects the axis z t _ ± 

► Under the above assumptions A t is achieved by 

1. Rot(z,di ) 

2. Trans(z,di) 

3. Trans(x,a i ) 

4. Rot(x,ai) 

► A t = Rot(z, 6 t ) * Trans(z, * Trans(x, a^) * Rot(x, a t ) 
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A.i = Trans S!di Trans Xia , Rot^^ 
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The parameter a is the distance between the axes z 0 and z x measured along the 
axis x ± 

► The parameter a is the angle between the axes z 0 and z lt measured in a plane 
normal to x ± axis 

► The parameter d is the perpendicular distance from the origin O 0 to the intersection 
of the x ± axis with z 0 axis measured along the z 0 axis 

► The parameter 6 is the angle between x 0 axis and x t axis measured in a plane 
normal to z 0 axis 

► Hint: 

► d : is, only, the variable in case of prismatic joints 

► 6 : is, only, the variable in case of revolute joints 
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Assign z t to be axis of actuation of joint i + 1 

2. Establish arbitrarily the base frame: x 0 ,y 0 , (z 0 determined in step 1) 

3. Define x t based on one of three cases 

a. The axes z and z t intersects 

b. The axes z t _ ± and z t are parallel 

c. The axes z i _ 1 and z t are not coplanar 

4. Define y t in the appropriate direction to complete the frame 

5. The final coordinate frame o n x n y n z n is commonly referred to as the end-effector or 
tool frame. The origin 0 n is most often placed symmetrically between the fingers of 
the gripper 
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z i _ 1 and z t are intersected 

Xj is chosen normal to the 
plane formed by z i _ 1 and z L . 

The positive direction of x t is 
arbitrary. 

The most natural choice of o t 
to be at the intersection point 
of z i _ 1 and Zj 

In this case a t equal zero 


z i _ 1 and z t are parallel 

There are infinitely common 
normal between them 

DH1 doesn’t specify Xj 
completely 

It’s free to choose o t anywhere 
along Zj 

The normal going through o t is 
chosen to be x t 


Zi_ ± and z t not coplanar 

There exists a unique shortest 
line segment from z i _ 1 to z tl 
perpendicular to both of them 

This line segment defines x t 

The point where the line of x t 
intersects Zj is the origin o t 
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► Assignment of coordinate frames according to the defined rules 

► Construction of DH-Table containing the parameters of each 
transformation matrix between two successive links 

► Compute the transformation matrix A t for each link 

► Compute the whole homogenous transformation matrix T® 

► Remember: 

► = Rot(z, 6i) * Trans(z, d t ) * Trans{x, * Rot{x, a{) 

► H = T°=A 1 (q 1 ) A n (q n ) 
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Link parameters for 2- Link planar manipulator 
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The T -matrices are thus given 

I? = A! 
r 2 ° = A\Ai = 


C12 -512 0 

512 C 12 0 d\S\ &2S\2 
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Three-Link Cylindrical Robot 
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Vi 


Vo 


Link parameters for 3-Iink cylindrical manipulator 
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ci —st 0 0 
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